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ABSTRACT 


A Montecarlo  simulation  is  conducted  to  ascertain 
performance  of  the  ATIGS  system  in  a proposed 
air-launched  cruise  missile  configuration.  The 
simulation  is  conducted  within  a local-level  inertial 
frame  consisting  of  down-range,  cross-range  and  up  as 
primary  reference  vectors.  Efforts  are  made  to 
measure  the  relative  effects  associated  with  the 
intended  pure  position  reset  provided  by  a micrad 
sensor  as  compared  with  those  effects  which  could  be 
expected  from  a linear  suboptimal  Kalman  filtering 
scheme  used  in  conjunction  with  the  MICRAD  sensor 
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I.  INTRODUCTION 


The  purpose  of  the  Advanced  Tactical  Inertial  Guidance 
System (ATIGS)  program  is  to  demonstrate  the  feasibility  of  a 
low  cost  inertial  system  to  be  used  in  the  Air  Launched  Low 
Volume  Ramjet  (ALVRJ)  cruise  missile  for  mid  course 
guidance.  Within  the  framework  of  this  stated  purpose  lies 
the  intent  to  furnish  moderate  accuracy  in  a strapdown 
inertial  navigator  with  high  reliability  of  operation. 

The  strapdown  inertial  system  requires  a computer  to 
provide  inertial  reference  , hence  the  possibility  of 
extending  the  computer's  capability  by  installation  of 
Kalman  filtering  algorithms  is  seen  as  an  area  for 
investigation.  Previous  work  (ref.  1,2)  in  this  field 
indicates  that  the  computational  burden  associated  with  the 
Kalman  filter  limits  its  usefulness  when  position  updating 
systems  in  the  missile  give  highly  accurate  measurements  of 
actual  position.  Most  of  the  aforementioned  computational 
burden  resulted  from  the  on-line  gain  generation  required  by 
a non-linear  model  within  the  Kalman  filter.  Hence  if  a 
linear  model  with  sufficient  performance  were  to  be 
incorporated  and  the  Kalman  gains  generated  off-line  and 
stored,  then  possibly  the  velocity  estimation  errors  which 
are  largely  unaffected  by  the  position  updates  could  be 
reduced. 

The  purpose  of  this  study  was  then  threefold 

1)  Test  a linear  model  of  missile  dynamics  for  use  as  a 
simulation  tool. 
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2)  Determine  the  inertial  navigator  accuracy  within  the 
six  degree  of  freedom  simulation  when  a pure  position  reset 
device  is  installed  which  provides  position  updates  at  two 
points  along  the  flight  path. 

3)  Determine  improvements  in  missile  performance  if  a 
Kalman  filtering  scheme  were  installed  to  estimate  missile 
states  between  position  updates. 

The  means  by  which  accomplishment  of  the  desired 
purposes  was  obtained  were  various  flontecarlo  simulations 
utilizing  existing  data  on  the  proposed  inertial  guidance 
system.  Extensive  work, both  in  testing  of  physical 
equipment  and  in  simulation,  had  previously  been 
accomplished  by  various  departments  of  the  Naval  Weapons 
Center,  China  Lake, California.  Hence  accurate  data  as  to 
component  performance  were  available.  These  data  were 
utilized  to  construct  models  of  the  components  for  computer 
simulation. 

The  simulation  of  a strapdown  inertial  guidance  system 
reguires  the  nonlinear  computations  relating  observed 
accelerations  to  inertial  frame  coordinates.  This  is 
normally  accomplished  within  the  guidance-navigator 
algorithm  by  a suitably  chosen  set  of  state  variables  and 
their  related  non-linear  dynamics.  The  essential  idea 
behind  the  linearization  technique  used  in  this  report  is 
that  the  non-linear  calculations  relating  accelerations  and 
angular  rates  to  velocity  changes  within  the  inertial  frame 
could  be  accomplished  upon  observation  of  the  said 
accelerations  and  rates  and  utilized  as  forcing  functions 
for  a linear  model  of  system  dynamics.  This  corresponds  to 
a free  inertial  system  with  observations  physically  aligned 
in  the  inertial  frame  of  reference.  Thus  velocity  changes 
in  the  inertial  frame  of  the  strapdown  guidance  system  would 
be  the  non-linear  combination  of  accelerations, angles  and 
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angle  rates  which  are  treated  as  inputs 


The  model  dynamics  then  are  simple  linear  equations  for 
which  Kalman  filtering  gains  can  be  calculated  and  stored. 

The  proof  of  the  above  linearization  technique  would  be 
in  comparison  of  the  existing  empirical  performance  of  the 
ATIGS  system  with  the  observed  corresponding  simulation  of 
the  system  without  Kalman  filtering  installed.  Ref. (3) 
provides  ample  data  of  the  drift  of  the  ATIGS  system  as  a 
function  of  time  under  actual  flight  conditions.  The  data 
are  for  a pod  mounted  version  of  ATIGS  installed  on  an  A-7 
aircraft.  Information  from  this  report  indicated  that 
ground  test  drift  of  the  system  was  on  the  order  of  1 
nautical  mile  (nm  ) per  hour  under  controlled  temperature 
conditions.  Dnder  free  flight  test  conditions  without 
temperature  control,  performance  was  degraded  to  4 nm  per 
hour.  The  temperature  instability  was  not  incorporated  into 
the  simulation  due  to  current  effort  to  provide  corrective 
measures  within  ATIGS.  Hence  verification  of  the  model  was 
assumed  if  simulation  indicated  drifts  of  1 to  2 nm  per 
hour. 


Once  verification  of  inertial-physical  model  was 
assumed,  the  next  phase  of  observation  of  effect  of  pure 
position  update  was  commenced.  Ref. 2 in  an  unclassified 
portion,  contends  that  the  optimal  weighting  of  filtered 
position  estimates  and  highly  accurate  measurement  of 
position  is  such  that  the  filtered  estimates  are  ignored. 
This  being  the  case,  the  computational  burden  imposed  by  a 
time  varying  Kalman  filter  may  be  unwarranted.  The  implicit 
assumption  here  is  that  the  velocity  errors  incurred  in  an 
unfiltered  system  are  not  significantly  decreased  by  the 
filter.  Therefore  the  position  reset  feature  would  be 
sufficient  to  provide  required  accuracy  at  mid-course 
termination.  This  conclusion  was  tested  by  simulation  of 
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missile  flight  under  conditions  of  increased  noise  levels 
within  the  ATIGS  system  and  comparison  with  "normal" 
performance  obtained, wh ich  allowed  visualization  of  the 
magnitude  of  end  point  error  incurred  under  conditions  of 
pure  position  reset  and  different  noise  level  sensors. 

The  final  phase  of  study  was  the  filtering  of  the  sensor 
outputs  to  provide  more  accurate  estimates  of  velocity 
throughout  the  flight.  No  attempt  was  made  to  filter  the 
position  update  measurements  due  to  their  reported  accuracy 
(sigma=50  ft) . Thus  any  gains  in  performance  would  have  to 
be  from  the  filtered  estimates  of  position  after  position 
update  and  continuous  filtered  estimates  of  velocity.  The 
primary  indicator  of  accuracy  in  line  with  ref. 2 was  taken 
to  be  cross  range  error  and  cross  range  error  covariance  as 
a function  of  time. 
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II.  BASIC  DESCRIPTION  OF  THE  ATIGS  EQUIPMENT  UTILIZATION 


The  approach  selected  for  i uplementation  of  ATIGS  within 
an  actual  cruise  missile,  was  to  employ  a high-speed 
processor  tc  handle  transformation  updating,  earth  rate 
torguing  and  other  minor  tasks  in  order  to  save  on  time 
requirements  on  the  more  complex  navigation  and  guidance 
computer.  This  peripheral  processor  would  then  supply  the 
central  processing  unit (CPU)  with  the  necessary  information 
that  it  required  to  compute  position  within  the  inertial 
guidance  frame. 

Thus  the  basic  ATIGS  unit  involves  ring  laser  gyros  and 
accelerometers  providing  information  to  the  peripheral 
processor  wherein  after  suitable  transformation,  inertially 
referenced  changes  in  state  variables  are  supplied  to  the 
main  navigation-guidance  computer.  The  main  computer  (CPU) 
then  has  an  auxiliary  input  from  an  external  position 
measuring  device,  the  Microwave  Area  Correlation 
fixer (MICRAD) . The  MICRAD  system  is  designed  to  provide 
highly  accurate  position  measurements  at  two  or  three 
preselected  checkpoints  along  the  route  of  flight.  These 
position  updates  would  then  be  utilized  within  the  CPU  to 
reset  the  inertial  guidance  estimate  of  position. 

At  present  the  only  filtering  system  installed  is  an 
application  to  the  initial  alignment  scheme  wherein  a two 
stage  initialization  process  is  used  to  align  the  missile 
inertial  frame  with  the  parent  aircraft  inertial  frame. 
Filtering  is  not  used  presently  during  midcourse  guidance 
due  to  the  position  checkpoint  feature  and  the  short  time  of 
flight. 
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A block  diagram  indicating  proposed  ATIGS  utilization 
within  the  A1VHJ  is  shown  in  fig.1. 


Figure  1 - FUNCTIONAL  BLOCK  DIAGRAM  OF  THE  ATIGS 
INSTALLATION  HIIHIN  THE  ALVRJ  CRUISE  MISSILE 


III.  INERTIAL  SYSTEM  SIMULATION 


A.  SYSTEM  CONSIDERATIONS 


The  inertial  navigation  system  incorporated  in  ATIGS 
consists  of  the  Honeywell  GG-1300  Ring  Laser  gyro  (RLG)  and 
the  Sunstrand  Q-flex  accelerometer  acting  as  sensors. 
Empirical  performance  data  for  these  sensors  are  found  in 
table  (1).  Both  sensors  are  considered  to  be  of  the 
integrating  type  in  that  the  output  of  the  RLG  is  in  the 
form  of  total  angle  change  per  pulse  and  the  output  of  the 
accelerometers  are  total  velocity  change  per  pulse.  The 
measurement  is  accomplished  within  the  RLG  by  means  of  a 
counter  system  which  totals  the  number  of  fringe  pattern 
passages  during  each  pulse  period  and  similarly  within  tne 
accelerometers,  the  total  velocity  change  is  proportional  to 
the  magnitude  of  the  output  pulse. 

In  view  of  the  above  characteristics  it  was  felt  that 
the  inertial  system  as  diagrammed  in  fig. 4 could  be  modeled 
simply  and  linearly  by  using  the  outputs  of  the  sensors  as 
forcing  functions  vice  part  of  the  state  vectors.  The 
similarity  between  fig. 1 and  fig. 4 should  be  noted.  This 
would  result  in  a net  reduction  in  number  of  state  variables 
by  allowing  the  missile  dynamics  to  consist  of  second  order 
equations  of  displacement  and  first  order  equations  for 
angular  motion. 


B.  INERTIAL  FRAME  OF  REFERENCE 
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1 • AL VBJ  Implementation 


The  proposed  ATISS  application  to  the  ALVRJ  utilises 
a local-level  co-ordinate  frame  for  navigation  to  the 
target.  The  local-level  frame  is  characterized  by 
North, East  and  up  as  the  respective  axis  of  calculations. 
The  non-spherical  nature  of  the  earth  introduces  an  angle 
calculation  which  relates  the  local  gravity  vector  to  the 
position  vector  of  the  origin  from  the  earth's  center.  In 
the  ATIGS  unit,  the  gravity  vector  calculation  is 
accomplished  by  an  inverse  square  gravitation  model 

G =»  - ( KM/R3)  R (1) 


where 

G gravity  vector 

K earth's  gravitation  constant 

M mass  of  the  earth 

R position  vector  from  earth  center  to  vehicle 

which  approximates  the  local  gravity  vector  to  the  desired 
degree  of  accuracy. 

The  vector  output  of  an  orthogonal  set  of 
accelerometers  is  the  geometric  sum  of  all  forces  which  act 
upon  the  vehicle  and  of  course  gravity  is  included.  Since 
the  above  calculation  is  dependent  on  position,  then  the 
gravity  vector  is  not  constant  during  the  time  of  flight. 
Thus  to  distinguish  between  the  effect  of  external  forces 
applied  to  the  missile  and  the  change  in  the  gravity  vector 
an  equation  such  as  i ..  (2) 
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force  exerted  on  instruments 


a coordinate  transformation  relating  inertial 

axis  (i)  to  accelerometer  axis  (a) 

R£  inertially  referenced  acceleration 

G gravity  vector 

resolves  the  time  varying  accelerometer  outputs. 

ATIGS  accomplishes  the  above  procedure  within  the 
missile  and  calculates  the  proper  direction  and  range  for  a 
direct  steer  to  the  target. 


2.  System  Simulation 


The  simulation  of  the  ATIGS  mission  began  by 
approximating  the  local-level  inertial  frame  defined  in  1. 
above  as  a down-range , cross-range  and  up  frame  of  reference. 
Due  to  the  limited  range  of  the  missile  the  gravity  vector 
was  considered  constant  and  known,  hence  the  simulation 
simplified  to  a simple  cartesian  co-ordinate  space  wherein 
the  navigator  assumes  knowledge  of  initial  position,  target 
position  and  range  to  target.  The  correct  heading  to  the 
target  was  assumed  to  be  the  positive  x-direction  with  the 
right-hand  system  defining  positive  cross-range  accordingly. 

The  initial  position  of  the  inertial  frame  of 
reference  was  taken  to  be  the  origin  and  instantaneous 
headings  were  taken  to  be  the  difference  between  the 
longitudenal  body  axis  and  the  positive  x direction. 

The  ALVRJ  maintains  a constant  wings  level  flight 
and  this  restriction  was  also  placed  upon  the  simulation. 
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C.  GENERAL  DEVELOPdENT 


Defining  a set  of  state  variables  for  an  inertial  system 
undergoing  arbitrary  two  dimensional  translation  and  making 
the  careful  restriction  that  small  angles  and  very  small 
angular  rates  are  involved,  one  obtains  (neglecting  all 
noise  inputs) 

x Distance  from  origin  down-range 

• 

X Velocity  in  down-range  direction 

Y Distance  from  track  centerline 

• 

Y Velocity  component  vertical  to  centerline 

Theta  Angular  displacement  of  body  longitudinal  axis  to 

centerline 


Due  to  the  small  angles  and  negligible  effect  of  angular 
rates  one  can  approximate  the  accelerome ter  outputs  as 
Zi=accel.  in  longitudenal  body 

axis  = Aitj=  AVib  (3) 

Z2=accel.  in  lateral  body  axis= 

A2b=  A V2b 


where  the  fi  subscript  indicates  body  axis.  Tne  output  of 
the  single  gyro  is 


z3=  6t*AT  =de1 


(4) 


Now 


A&=  AV^cos  ©1-  AV^sin  9^  + V^Acos  0^ 
-V2b A sin  9^ 

A AV^sin  ^V2bcos  01  + V^^sin 
+V2fe  Acos  0^ 


(5) 
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; 


i 


A 


Where 


AX=Z1cos  81~Z2sin  O^+V^&cos  8^-V2t)Asin 


(6) 


A t=Z^sin.  +Z2cos  sin  01  +V2^cos  ©1 


Which  can  be  further  approximated  by 

A^z1-z2e1-vlbe1a61-v2ba91 


Szrzz9rv2bz3 

SzlWvlbZ3 


(7) 


Further  utilization  of  small  angle  approximation  yields 


V!b=  * 
V2b=  * 


Hence 


(8) 


^x=  zi  - z20l  - yz3 
A Y = Zft  + z2  + X z3 


(8a) 


and  for  unit  time  intervals  the  discrete  state  equations  are 
X(k+1)=  X(k)  + X(k)  + .5*A*(k) 

£(k+l)=  X(k)  +A*(k) 

Y ( k+1 ) = Y(k)  + t(k)  + . 5*  A Y(k)  (9) 

Y(k+1  )=  t(k)  +At(k) 

0^k+l)=  Q^(k)  +A01(k) 
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Thus  the  observations  can  be  treated  as  inputs  to  the 
system  after  appropriate  substitution.  The  above  model  can 
be  expanded  to  three  dimensions  and  six  degrees  of  freedom 
by  the  addition  of  one  cartesian  and  two  angular  coordinates 
which  would  then  consist  of 

Z (k) , Z (k) , ©2 * 0^ 

for  a total  of  9 states. 

This  development  was  accomplished  without  noise 
considerations,  in  the  physical  system  noise  would  exist  in 
the  form  of  measurement  noise  in  both  the  accelerometers  and 
the  gyros.  Hence 

V^’n,  + * 

Z2=^V2b  + (10) 

zrAei  + P. 

and 

- zt  . 

air  = z191  +z2+  toy  ^ e1+  £ +xy? 


The  purpose  of  this  approach  was  to  utilize  the  outputs 
of  the  sensors  as  forcing  functions  for  the  linear  model. 
Hence  in  the  preprocessor  the  non-linear  calculations 
involving  observations  and  states  can  easily  be  accomplished 
such  that  one  then  obtains 


U1  = 

» 

U2  = 

9 


Z1  - Vl  - i23 

zle  1 + z2  + *z3 


u0  = z. 


(12) 


as  hypothetical  and  known  forcing  functions.  Thus 
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substitution  into  the  model  of  the  system  of  0 £« 0 zorAXOc) 
• • * 
and  VlCk)  for  Ayt*)  would  result  in 

X(k+1)  = X(k)  + X(k)  + . 5*( A X(k)  + 

+ + t(k)  # ) 

*(k+l)  = X(k)  + -Ax(k)  + A + 4ei(k) 

+ Y(k)$P  (13) 

Y(k+1)  = Y(k)  + t(k)  + ,5*(At(k)  + A ©1(k) 

+ +X(k)<#  ) 

Y ( k+1 ) = t(k)  + A Y(k)  + ^ ©1(k)  + 4 

+ X(k)^ 

91(k+l)a  01(k)  + A 9t(k)  + <fi 

Hence  the  net  result  is  the  addition  of  a process  noise 
term  to  the  model.  Analysis  of  this  noise  term  proceeds 
with  the  systematic  elimination  of  the  non-linear  term 
involving  **"  and  © . This  is  easily  justified  due  to 
the  small  value  of  If  and  O . Thus  one  is  left  with 
down-range  process  noise  involving  and  <•/  and 

cross-range  noise  terms  involving  and  XjP  . Clearly 

the  non-linear  terms  will  dominate.  The  conclusion  that 
logically  follows  is  that  the  linearization  technique 
utilized  above  will  obviously  be  accurate  for  small  angles 
in  a manner  proportional  to  the  magnitudes  of  the  quantities 
y</>  and  . Furthermore  it  indicates  that  Kalman 

filtering  will  be  most  effective  in  the  estimation  of  angle 
information  and  of  much  smaller  benefit  in  the  filtering  of 
accelerometer  noise. 


PARAMETER 


BIAS  STABILITY  (/hr.)  SAME 


BIAS  SENSITIVITY 

(°/hr- 

6f) 


SCALE  FACTOR  (%) 


BIAS  UNCERTAINTY 

(ug) 


SCALE  FACTOR  (ug/g) 


UNIT 

PERFORMANCE 

GG- 1300-RLG 

.0075 

SAME 

.009 

SAME 

. 00037 

SAME 

.016 

Q-FLEX 

79.0 

SAME 

63 

i 

J 

! 
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Thus  the  total  state  vector  would  consist  of  9 states  as 
opposed  to  the  15  Gtate  vector  considered  essential  in 
reference  2.  The  above  technique  was  inspired  by  Kortum  in 
his  development  (ref.  6)  on  Kalman  filter  applications.  The 
inertial  computation  scheme  is  based  on  several  assumptions, 
all  of  which  are  results  of  the  short  time  of  flight-short 
range  requirements  of  the  ALVRJ  application.  These 
assumptions  are 

1.  Constant  gravity  vector  over  a 40  nm.  flight  path 

2.  Earth  torguing  not  required 

3.  Small  angle  assumptions  for  largest  portions  of 
flight 


D.  BASIC  SIMULATION  DESIGN 


1 . General  Considerations 


In  order  to  verify  that  the  nine  state  system  would 
be  adequate  for  modeling  purposes,  a simulation  program  to 
test  performance  was  conceived.  The  actual  missile  flight 
profile  includes  accelerations  after  launch 
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up  to  a maximum  of  16  g' s (fig. 5) from  the  initial  conditions 
given  in  fig. 6.  In  addition,  it  is  to  be  noted  that  for 
simplicity  a homing  type  guidance  command  is  given  to  the 
missile  dynamics.  This  is  recognised  as  ineffecient  in 
practice  but  is  simple  in  implementation  and  provides  a 
basis  for  comparison  purposes.  Since  missile  flight 
controls  respond  to  airspeed  and  not  inertial  speed,  the 
velocities  used  in  the  missile  dynamics  portion  of  the 
algorithm  ate  true  airspeeds.  However  the  inertial  system 
must  always  compute  in  inertial  velocities  and  hence  must 
either  adjust  its  calculations  to  include  this  difference  or 
accept  any  error  that  this  difference  may  entail.  It  is  to 
be  noted  that  no  means  of  velocity  measurement  (i. e. 
doppler,mach  gauge, etc.)  is  to  be  provided.  In  this 
simulation  the  difference  is  ignored  due  to  the  large 
magnitude  of  inertial  velocities  obtained  and  the  short  time 
of  flight. 


2 • Noise  Input  Design 


The  random  number  generators  used  in  this  simulation 
were  of  two  types;  Gaussian  and  uniform.  The  Gaussian 
generators  provided  the  noise  inputs  to  the  various  sensors 
and  the  uniform  generators  provided  the  initial  conditions 
and  wind  effects.  The  wind  effects  were  such  that  constant 
bias  directions  of  positive  cross  range  and  negative 
down-range  conditions  were  imposed.  The  mean  value  of  wind 
components  in  each  direction  was  30  ft  per  sec.  with  a 
range  of  ♦ /-8  ft  per  sec.  maximum  change  per  second.  No 
attempt  was  made  to  ascertain  the  relevance  of  the  chosen 
wind  model, its  purpose  was  purely  to  introduce  a bias  into 
the  system  eguations  in  order  that  the  scale  factor  noise 
term  of  the  gyros  could  be  exercised.  The  scale  factor  term 
was  finally  dropped  from  the  model  of  the  gyros  but  the  wind 
bias  was  retained. 
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The  Gaussian  generators  provided  noise  inputs  to 
each  of  the  six  installed  sensors.  The  chosen  model  of  the 
accelerometer  noise  term  was 


* 1,2,3-  E0G1.2.3  +WG1.2.3*A1,2,3 


(14) 


where 

BOG  random  bias  term  held  constant  over  the  entire 

flight  but  varied  prior  to  each  sample  in  the  montecarlo 

WG-scale  factor  term  which  varies  through  the  flight 


The  chosen  model  for  the  gyro  noise  term  was  more 
complex  consisting  of  bias  terms  and  a random  walk  term.  A 
random  walk  generatior  is  described  in  general  terms  as 


(15) 


where  Er  is  the  error  at  a given  instant  and  Ur  is  a 
white  noise  term  with  a standard  deviation  of  . The 

variance  of  Er  grows  linearly  with  time  according  to  the 
relation 

0*|  = t (r^  (16) 

r r 

with  0^  given  empirically  in  table  1 as  random  walk  in 
/'hr  with  an  uncertainty  ofl(Tlh<-  =.0075  . For  a sample 

generator  to  be  used  every  second 

cr  = c r / 60  (17) 

r r 


An  error  from  each  gyro  is  introduced  into  the 
inertial  computation  which  is  treated  as  a change  in  e 

p (t)  = EO  + G(t)  (18) 

PHI  error  of  each  gyro  per  interval  of  time 


1 
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£0  constant  bias  term  per  flight 
G result  of  random  walk 

3.  Changes  in  Heading  aesulting  in  Velocity  Changes 

The  computation  of  velocity  in  the  inertial  frame 
consists  of  terms  which  relate  the  change  in  heading  to 
changes  in  inertial  velocities.  For  small  angular  rates  the 
changes  in  velocity  in  the  inertial  frames  show  as  inputs 
i.e.  AWXX,AWXY,  AWYY,AWYZ,  AWZZ,  AWZX. 

AWX Y is  the  change  in  velocity  in  the  X (down- range) 
direction  due  to  a change  in  direction  6^  . This  is 
expressed  in  small  angle  approximations  as 


AWX 

AWY 

= 

AWZ 

* 

1 

Aer 

-A0, 


- A6, 

1 

- AS, 


A9, 

A0. 


X 

T 

Z 


(19) 


AWX  is  the  total  change  in  velocity  in  the  x direction  due 
to  small  angle  change.  This  calculation  is  performed  in  the 
appropriate  missile  dynamics  portion  of  the  simulation  where 
the  A©*  are  the  results  of  commands  from  the  guidance 
system  of  the  inertial  system.  In  the  inertial  system  these 
guantities  are  treated  as  or  measured  changes  and  all 
velocity  changes  are  computed  based  on  gyro  outputs. 

4.  Guidance  System  Design 
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The  specific  algorithm  for  generation  of  guidance 
commands  Has  simple  due  to  the  homing  type  control  employed. 
Inherent  in  the  cross-range, down-range  reference  frame  is 
the  knowledge  of  distance  remaining  or  "time- to- go"  for 
termination  cf  midcourse  guidance  and  initiation  of  terminal 
guidance  procedures.  A parameter  that  continues  to  be 
significant  within  this  project  is  the  small  angle,  small 
rate  assumption.  In  the  guidance  algorithm  the  one  second 
time  intervals  chosen  for  use  would  require  an  inordinately 
long  sequencing  operation  if  commands  were  given  in  terms  of 
rates.  To  clarify  this  statement,  rate  systems  require  an 
initiation  and  termination  command,  which  for  one  second 
intervals  would  require  a two  second  execution  time. 
Therefore  the  guidance  system  employed  within  this  project 
determines  total  angle  change  necessary  and  then  commands  an 
automatic  pilot  to  accomplish  this  change.  Thus  the  forcing 
function  to  the  inertial  navigator  equations  is  not  an  input 
to  the  rate  variables  but  rather  to  the  angular  displacement 
variables.  No  process  noise  was  assumed  for  small  angles 
hence  the  actual  angle  change  was  set  equal  to  the  commanded 
angle  change.  Notice  that  this  is  basically  an  open-loop 
process  wherein  the  inertial  navigator  does  not  predict  the 
next  state  based  on  the  commanded  heading  change  but  rather 
on  the  noisy  observed  heading  change. 

The  logical  question  then  arises  as  to  the  effect  of 
system  drift  during  guidance.  Normal  procedure  would  be  for 
a heading  change  command  system  in  which  an  error  signal 
generated  by  the  navigator  would  be  driven  to  null  by  the 
rotation  of  the  vehicle.  System  drift  during  the  heading 
change  operation  would  result  in  process  noise  inputs  to  the 
navigator  equations.  The  above  was  felt  to  be  undesireable 
due  to  Kalman  filter  operation  characteristics  wherein 
steady  state  gains  are  non-zero  for  a linear  system  under 
process  noise.  The  method  of  circumventing  this  discrepancy 
was  to  use  as  the  forcing  function  the  observed  heading 
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change  for  the  update  of  the  navigator.  Thus  in  the  absence 
of  process  noise  an  accurate  indicator  of  measurement  noise 
would  be  the  difference  between  observed  heading  change  and 
commanded  heading  change.  This  concept  was  to  be  used 
during  the  Kalman  filter  application. 


The 

fig. 5.  The 
estimate 
calculation 
homing. 


algorithm  for  command  guidance  is  given  in 
"time-to-go"  concept  allows  for  a continual 
of  distance  remaining,  and  a simple  heading 
computes  the  heading  change  necessary  for 


uired" 


gross-range  position 

final  position  - present  position  ^ 2Q ^ 

240000-X ( k ) 


It  should  be  noted  that  the  flight  profile 
simulation  was  terminated  at  a point  where  the  inertially 
computed  down-range  position  was  greated  than/or  equal  to 
the  final  position.  This  would  correspond  to  the  switchover 
point  for  terminal  guidance. 
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Figure  6 - GUIDANCE  COMMANDS  ALGORITHM 
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STATE  VARIABLE 


POSITION 


VELOCITY 


ALIGNMENT 


i 


Pigare  7 


COORDINATE 

MEAN 

STD. 

, DEVIATION 

downrange 

0.0  ft 
(0.0  m) 

1 

= 387.0  ft 
(118  m) 

crossrange 

0.0  ft 
(0.0  m) 

1 

= 387.0  ft 
(118  m) 

altitude 

35000  ft 
(10668  m) 

1 

= 0.0  ft 
(0.0  m) 

downrange 

crossrange 

vertical 


670  ft/sec 
(204.2  m/sec )) 

670  ft/sec 
(204.2  m/sec )( 
0.0  ft  /sec 
(0.0  m/sec) 


=6.0  ft/a. 

(1.83  m/i 

=6.0  ft/s 
(1.83  m/- 
=0.0  ft/s 
(0.0  m/s 


■ INITIAL  CONDITIONS  AT  LAUNCH 
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Figure  8 - ALGORITHM  F08  MODEL  OF  MISSILE  DYNAMICS  WITH 
PURE  INERTIAL  COMPUTATIONS 
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5.  Position  U pdate  System 


The  position  update  s ystem (MICEAD)  is  designed  to 
fix  the  missile  position  at  various  check  points  along  the 
flight.  Currently  it  is  intended  for  the  missile  to 
navigate  to  each  checkpoint  inertially  and  upon  arrival  fix 
its  position.  The  missile  would  then  compute  the  course  to 
the  next  check  point  and  proceed  to  navigate  to  that  point. 

For  purposes  of  this  simulation  and  in  order  to 
reduce  complexity  and  computer  time  requirements,  the 
missile  estimated  position  was  set  equal  to  its  actual 
position  at  two  discrete  time  steps.  The  inertial 
navigation  system  was  thus  reset  at  time=15  sec  and  time=80 
sec . 


The  projected  accuracy  of  the  MICEAD  position 
measurement  system  is  (T -•  50  0 ft  at  low  altitudes.  Thus  a 
noise  term  was  added  to  the  measurement  of  position  within 
the  simulation  in  an  effort  to  retain  agreement  with 
empirical  data. 

The  magnitude  of  the  deviation  of  the  position  fix 
is  the  fundamental  argument  in  ref. 2 for  the  elimination  of 
the  Kalman  filter  from  the  inertial  system.  The  rational 
behind  this  assertion  is  that  if  two  estimates  of  position 
are  available  (i.e.  Kalman  filter  position  estimate  and  a 
MICEAD  estimate)  then  the  weighting  placed  on  each  estimate 
would  be  heavily  in  favor  of  the  more  accurate 
estimate , logically  the  MICEAD  fix.  The  optimal  mix  of  the 
two  estimates  would  then  be 

X = M Xn  + (I-M)  Xm  (21) 
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where 


= navigation  estimate  = X + p 

p = navigation  estimate  error 

X = measurement  estimate  = X + r 
m 

r = measurement  error 
M = r / (r  + p) 
thus 

X =(r/(r+p))Xn  + (p/(r+p))Xm  (22) 

since  logically 

r<  < P 


and  the  Hainan  filter  estimates  are  ignored. 

Prom  the  above,  it  can  be  seen  that  filtering  for 
positon  is  required  only  in  the  intervals  between 
observations  and  that  the  optimal  mix  of  filtered  position 
and  observed  position  reduces  to  the  observed  position  for 
highly  accurate  measurements. 


6 . Statistical  Formulations 


The  primary  measures  of  system  performance  for 
inertial  navigation  systems  are  mean  of  estimation  error 
(i.e.  the  mean  of  actual  position  minus  inertially 
calculated  position)  and  variance  of  estimation  error.  The 
mean  of  estimation  error  reflects  the  result  of  bias  within 
the  inertial  system  and  the  variance  of  estimation  error  is 
an  indication  cf  system  reliability.  The  simulation  program 
adopted  in  this  study  evaluated  the  mean  of  position  and 
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velocity  as  well  as  their  variance  at  each  one  second 
interval  along  the  flight  path  in  addition  to  the  estimation 
error  mean  and  variance.  The  final  position  states  were 
also  computed  and  the  mean  and  variance  presented 
seperately.  It  was  felt  that  this  information  could  give  a 
qualitative  comparison  of  the  missile  performance  with  and 
without  the  Kalman  filter  installed. 

The  mean  and  variance  equations  for  each  time 
interval  was  computed  using  standard  summation  and  averaging 
techniques.  Thus 


with  the  inherent  assumption  that  the  relative  frequency  of 
occurence  is  analagous  to  the  probability  of  occurence.  The 
variance  was  computed  similarly  with 

S2  = (1/ (n-1 ) ) Y (x.-X)2  (24) 

1 x 
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IF.  KALMAN  FILTER 


A.  INTRODUCTORY  REMARKS 


Ref. 12  discusses  various  aspects  of  the  philosophy  of 
Kalman  filter  applications  in  a very  concise  manner.  Within 
this  discussion  the  practical  limitations  of  implementation 
are  specified;  the  foremost  limitation  being  that  of  a 
prerequisite  knowledge  of  the  exact  statistical  description 
for  each  random  signal  within  the  system.  This  a priori 
information  determines  the  degree  of  optimality  of  the 
filter. 

The  filter  is  said  to  be  optimum  in  the  sense  that  it 
generates  an  unbiased,  minimum  variance  estimate  of  the 
states  of  a linear  system  from  some  noisy  measurement  of  a 
subset  of  those  states.  The  requirements  imposed  upon  tne 
designer  are  ; exact  knowledge  of  the  system  dynamics, 
covariances  of  initial  conditions,  and  noise  inputs. 
Departure  from  optimality  arises  when  either  estimates  of 
the  above  quantities  are  used  or  approximations  to  the  state 
equations  with  lesser  state  variables  comprise  the  model  of 
system  dynamics. 

Previous  studies  indicate  that  best  results  are  obtained 
with  pessimistic  estimations  of  design  parameters  and 
linearization  of  non-linear  systems  if  possible.  The 
pessimistic  estimate  of  design  parameters  reduce  the 
sensitivity  cf  the  design  to  deviations  within  the  system 
while  linearization  results  in  off-line  gain  calculations 
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which  significantly  reduce  the  computational  requirements. 


The  linearization  technique  analysis  of  this  study 
indicates  that  the  model  of  the  system  error  terms  are  most 
critical  in  the  estimation  of  theta.  The  cross- range  and 
down-range  position  error  being  most  dependent  on  these 
terms.  Since  digital  filtering  computational  requirements 
increase  roughly  as  the  square  of  state  variables, 
effeciency  dictates  that  the  number  of  filtered  variables  be 
minimized.  Therefore  it  was  felt  that  the  best  usage  of 
Kalman  filter  techniques  would  be  in  the  estimation  of 
theta. 

This  evaluation  is  supported  by  various  references  (6, 8) 
most  notably  ref. 6. 


B.  GENERAL  THEORY 


Given  a plant  characterized  by 
equations: 

X(k+1)=  (k+1  ,k)X(k)  + A(k+l,k)U(k)+  W(k) 

Z(k)  = C(k)X(k)  + V(k) 


the 


(25) 


where 


linear  discrete 


X(K)  Column  matrix  of  states 

•v 

0(11+1,10  state  transition  matrix  for  time  k to  time  k + 1 

A(kW,0  Forcing  transfer  function 

w(k1  Process  noise  term 

Z.IK)  Matrix  of  observations 

V(*)  Measurement  noise 
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Hith  the  appropriate  assumptions  concerning  zero  mean 
noise  terms  and  knowledge  of  the  covariance  of  initial 
conditions,  the  optimal  estimate  of  the  state  vectors  at 
time  k can  he  arrived  at  through  suitable  use  of  a Kalman 
filter.  This  estimate  will  be  characterized  by  a minimum 
variance  of  estimation  error  as  its  criteria  for  optimality. 
The  Kalman  filter  equations  are: 

£(k)  = P^/k-Dj^k)*  [c(k)p(k/k-l)C(k)  + R(k)] 

P(k/k)  = £l-G(k)C(k)3  P(k/k-l) 

P(k+l/k)  = <jt)  (k+1 ,k)P(k/k)  ^(k+l.k)  + jg(k) 

X(k/k)  = X(k/k-l)  + G (k)  [_Z_(k)  - C(k)X(k/k-lJ 
X(k+l/k)  = ^ (k+l,k)X(k/k)  + A(k+l,k)U(k) 

where  the  notation  (k+1/k)  implies  the  estimate  at  time  k+1 
given  time  k. 

C.  SPECIfIC  THEORY 


-1 

(26) 


The  current  method  of  filtering  inertial  navigation 
systems  is  by  building  the  filter  specifically  around  a 
given  error  model  of  the  gyro.  The  most  commonly  used  error 
model  is  a Gauss-Markov  drift  model  described  by  both 
correlated  n cise  and  bias  terms. 

D = - (1/Y  )D  + r - (27) 

where  D is  the  instantaneous  value  of  error,  Y is  the 
correlation  time  and  r*  is  a bias  term.  Statistically 
the  time  function  has  been  found  to  be  roughly  equivalent  to 
a random  walk  model  such  that 

D = w + r (28) 
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where  W is  a white  noise  term.  Since  the  above  drift  is 
colored  noise  it  has  been  handled  previously  by 
incorporating  it  in  the  state  matrix  such  that  it  is  part  of 
the  estimation  process.  The  state  equations  would  then 
become 


D = w + r 
Z = ©2+  D 


(29) 


Thus  the  Kalman  filter  would  be  designed  for  a 3 state 
vector  vice  the  needed  two  states.  Also  the  presence  of 
process  noise  requires  a non  zero  steady  state  value  for  the 
gains  of  all  equations  in  the  update  portion  of  the  Kalman 
filter.  This  means  that  improper  choice  of  parameters  will 
bias  the  estimatior  for  all  time 


The  overriding  consideration  of  this  study  being  the 
desire  to  maintain  as  few  state  variables  as  possible 
prompted  a closer  look  at  the  above  method  of  analysis. 


The  inertial  navigator  had  been  modeled  as  a first  order 
system  earlier  (sect.  I) 

0I(k+l)  = 01 (k)  + ©M(k)  (30) 


however  the  Kalman  filter  requires  an  observation  matrix  and 
the  above  model  uses  the  observation  matrix  as  a 
forcing  function  therefore  for  filtering  purposes  the  rate 
variables  had  to  be  redefined  and  a new  state  added. 


6Ii(k+l)=  ei^k)  + ©I2(k)  + ASM 
0I2(k+l)=  0I2(k) 


(31) 


The  new  state  variable  GfJ^  is  to  represent  a small 
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angular  rate  which  should  be  zero  under  normal  conditions. 
Notice  that  the  forcing  function  is  solely  upon  the  angular 
position  and  not  upon  the  rate  variable.  Now  the 
observation  is  the  output  of  the  gyro  which  is 

A9M(k)  = A0(k)  + 9I2(k)*dt  + ^(k)Mt  (32) 

where  p is  the  noise  term  for  the  gyro  given  by 

p (k)  = EO  + G(k)  (33) 


20  is  a constant  bias  and  g ( Jc)  is  a white  noise  term.  The 
noise  equation  then  for  unit  time  intervals  are 

A <p(k)/  A t = EO  + G(k)  «A^(k)  (34) 

and  the  observation  equation  is 

4 9M(k)  = 4 0(k)  + 0I2(k)  + 

= 0(k)  + 0I2(k)  + EO  + G(k)  (35) 


Now  A©  is  a known  forcing  function  generated  by  the 
inertial  navigator  therefore  a new  observation  can  be 
defined  as 


Z*(k)  = A 0M(k)  - A 0(k) 

= 0I2(k)  + EO  + G(k) 


(36) 


thus  the  discrete  state  equations  are 


ei1(k+i)  = ei1(k)  + ei2(k)  + Ae(k) 
ei20c+i)  = ei2(k) 

Z*(k)  = ei2(k)  + EO  + G(k) 


(37) 


Now  if  the  constant  bias  term  EO  is  aided  to  the  ©T^CiO  and 


redefined  as 


ei2(k)  = ei2(k)  + EO 


(38) 
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Then  it  can  be  seen  that  the  ©1^1*0  term  takes  on  the 
significance  of  an  estimated  drift  and  the  state  equations 
then  assume  the  form 

QijOt+i)  = eix(k)  + ei^OO  + Ae(k) 

0X2  (k+1)  = 0I2  OO  (39) 

Z*(k)  = 0I2(k)  + G(k) 

Where  g(k)  is  white  noise  and  the  state  equations  are  now  in 
standard  form  for  Kalman  filtering. 

It  was  necessary  to  add  one  more  state  per  gyro 
simulated  but  this  brings  the  total  state  vector  to  only  12 
which  is  still  a net  savings  in  state  variables. 

A block  diagram  of  the  algorithm  is  given  in  fig. 09. 


D.  KALMAN  FILTER  RESULTS 


The  general  Kalman  equations  of  part  B above  were 
applied  to  the  angular  state  variables  in  an  off-line 
calculation  by  applying  pessimistic  estimates  of  initial 
condition  variance  such  that 


__  2 

el(of 


1.00  X 10 


03 


e2(0) 


1.000  X 10 


-03 


(40) 


and  the  variance  on  the  measurement  noise  to  be 


CT2(  ) = 1.000  x 10'03 

The  resulting  gains  were  found  to  be  simple  time 
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functions  such  that  at  time  T=K  A t 

GjCk)  = l-(2/k+l) 


V.  ANALYSIS  OP  RESULTS 


A.  VERIFICATION  OF  RESULTS 


Due  to  the  high  degree  of  simplification  of  plant 
dynamics,  the  basic  plant  model  is  felt  to  be  weak.  The 
linear  dynamics  applied  to  the  given  g profile  produced  a 
trajectory  similar  to  the  expected  flight  profile  of  the 
ALVRJ  but  (due  to  its  simplified  nature)  with  several 
defects.  The  descent  produced  a net  increase  in  forward 
velocity  after  level  off  which  would  not  be  the  case  for  a 
true  non-linear  model.  This  defect  can  be  accommodated  by 
the  inertial  system  and  hence  was  not  felt  to  be  detrimental 
tc  the  purposes  of  this  study. 

Further  work  in  this  area  would  be  recommended  in  order 
that  basic  defects  in  the  missile  such  as  thrust 
mis-alignment , process  noise  in  control  actuators  and  sensor 
misalignment  be  introduced  into  the  simulation  . A better 
tracking  scheme  could  easily  be  instituted  such  that  the 
guidance  algorithm  could  institute  a more  efficient 
tra  jectory. 

It  was  felt  that  for  purposes  of  this  study  the  plant 
model  provided  a reasonable  approach  to  ALVRJ  simulation. 
The  time  of  flight  and  velocity  profile  are  within  the  same 
general  order  of  magnitude  as  the  more  complex  simulations 
provided  by  ref . 1 and  correspond  with  physical  intuition  as 
to  proper  missile  performance. 


B.  VERIFICATION  OF  ATIGS  SIMULATION 


It  was  felt  that  the  simulation  of  the  ATIGS  would  be 
accurate  for  purposes  of  this  study  if  the  error  growth  rate 
and  the  standard  deviation  growth  rate  incurred  by  the  model 
were  close  to  the  observed  guantities  set  forth  in  ref.1  and 
ref. 3.  Reference  3 stated  that  observed  drift  in  the  ATIGS 
test  unit  was  approximately  1 nm  /hr  in  ground  test  and  4 nm 
/hr.  in  airborne  test.  The  simulation  results  show  a 
numerical  average  drift  of  3.35  nm  /hr.  which  was  felt  to 
be  in  the  range  of  the  actual  system.  Ref.1  indicates  that 
the  simulation  reported  therein  had  a cross-range  standard 
deviation  growth  rate  of  1400  ft. /min.  between  the  first  and 
second  reset  positions.  The  simulation  within  this  study 
had  a cross-range  standard  deviation  growth  rate  of  1459.4 
ft. /min. 

From  the  above  correlation  in  performance  the  study 
proceeded  under  the  assumption  that  the  simulated  model  of 
the  ATIGS  would  provide  a reasonable  background  for  analysis 
of  position  reset  and  Kalman  filter  performance  in  an  actual 
installation. 


C.  EFFECT  OF  POSITION  RESET  ON  SIMULATED  PERFORMANCE 


The  unfiltered  position  reset  feature  of  this  simulation 
had  the  expected  result  of  drastically  decreasing  the 
variance  at  mid-course  termination.  The  pure  inertial 
navigator  must  contend  with  both  initial  condition  errors 
and  integrated  boost  phase  errors  which  combine  to  produce 
large  scale  variance  at  mid-course  termination.  The  initial 
position  reset  occurs  after  boost  is  complete  and  thus 
virtually  eliminates  the  initial  condition  and  boost  effect 
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on  position.  However,  as  expected,  the  velocity  and  angular 
errors  of  boost  and  initial  condition  still  have  effects  on 
the  final  value  of  position  at  mid-course  termination.  The 
basic  A TIGS  navigator  without  position  reset  was  found  to 
have  a radial  uncertainty  of  1608.6  ft.  at  mid-course 
termination  (see  table3) . The  addition  of  position  reset  to 
the  basic  model  was  found  to  reduce  this  uncertainty  to 
466.9  ft.  However  these  figures  reflect  the  inherent 
accuracy  of  the  inertial  navigator  with  the  very  low  error 
terms  in  the  sensors.  If  the  noise  terms  in  the  inertial 
navigator  are  allowed  to  have  their  standard  deviations 
increased  by  a factor  of  5,  thus  simulating  a very  noisy 
inertial  navigator,  the  basic  ATIGS  model  without  position 
reset  demonstrates  an  uncertainty  of  8646.5  ft.,  and  after 
the  addition  of  position  reset, 4128.0  ft.  Thus  it  can  be 
seen  that, even  with  a position  reset  very  close  to 
mid-course  termination,  large  uncertainty  of  position  can 
accumulate  due  to  the  magnitude  of  the  velocity  errors  which 
accrue  throughout  the  flight. 


D.  EFFECT  OF  ADDITION  OF  LINEAR  SUBOPTIMAL  KALMAN  FILTER 


The  Kalman  filter  proposed  in  this  report  had  the  effect 
of  decreasing  the  variance  of  simulation  behavior  along  the 
flight  path  for  all  tested  situations  (see  table  2)  . If 
cross-range  standard  deviations  is  taken  as  the  criterion 
for  performance  quality,  it  can  be  seen  that  the  filtered 
performance  is  readily  superior  at  all  noise  levels.  The 
"normal"  noise  level  exhibits  a radial  uncertainty  of  248.03 
ft.  at  mid-course  termination  and  the  X5  noise  level 
exhibits  a radial  uncertainty  of  1083.1  ft.  The  fundamental 
reason  for  this  increase  in  accuracy  is  shown  in  table  4, 
where  the  velocity  errors  at  final  update  position  are 
compared.  The  filtered  velocity  estimates,  even  at  the 
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higher  noise  levels,  are  such  that  aid-course  termination 
position  is  within  such  more  reasonable  bounds. 

The  overall  effect  of  the  Kalaan  filter  proposed  in  this 
study  then  is  to  reduce  the  end  point  variance  of  missile 
position  at  aid-course  termination  in  a significant  manner. 
The  unfiltered  updates  of  position  are  seen  to  be  valuable 
when  used  in  conjunction  with  the  Kalman  filter  but  do  not 
insure  adequate  missile  performance  if  high  noise  levels  are 
encountered  throughout  the  flight. 

I 
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TABLE  2-SIMULATION  PERFORMANCE  WITH  TYPE  OP 


I 671.2  ft | 1018.9  ft ] 950.7  ft I 518.9 

Figure  11  - TABLE  3-FIHAL  POINT  PERFORMANCE  WITH  TYPE  OF 

INSTALLATION 
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type  run 

noise  level 

velocity  error 
std.  deviatior 

ATIGS 

NORMAL 

110.4  ft/sec 

ATIGS 

X5 

562.47  ft/sec 

NORMAL 

104.65  ft/sec 

X5 

642  ft/sec 

ATIGS .MICRAD 
& kaiAan 

NORMAL 

62.8  ft/sec 

£TM5CRAD 

X5 

262.47  ft/sec 
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Figure  12  - TABLE  4- VELOCITY  ERROR  OF  TYPE  OF  INSTALLATION 

AT  FINAL  CHECKPOINT 
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APPENDIX  A 


RESULTS  OF  ATIGS  SIMULATION  WITHOUT  FILTERING  OB  POSITION 

UPDATE 
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Figure  13  - SQRT  OF  DOWN  RANGE  VARIANCE  <ATIGS  ONLY> 
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Figure  14  - SQRT  OF  CROSS  RANGE  VARIANCE  < ATI GS  ONLY1 
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Figure  15  - SQRT*  OF  DOWN  RANGE  VELOCITY  VARIANCE  <ATIGS 

ONLY  J 
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Figure  16  - SQRT  OF  CROSSRANGE  VELOCITY  VARIANCE  < ATIGS 

ONLY* 
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APPENDIX  B 

RESULT  OF  ATIGS  SIMULATION  WITH  POSITION  RESET  ONLY 


— - 

n rn  H ® 2®  013  TIHfi  ISO 


Figure  18  - SQRT  OF  CROSS  RANGE  VARIANCE  <ATIGS  HITh  POSIT 

RESET) 
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1 HE  HE AN  PF  TRACK  VAR  OF  TRACK  MF AN  CF  ERROR  VAR  OF  ERROR 
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0.21 1690 

06 

X ( 6 1 -0.230980 

Cl 

0.601630 

03 

-0.2927MJ 

02 

0.531830 

03 

X 1 5 ) C.  350001? 

05 

0.2*5550 

03 

-0. 101 990 

01 

0. 161130 

05 

X 1 6 ! 

) 0.0 

0.0 

0.896660 

00 

0. 3**R650 

03 

XI  l)  0.3  706  60 

C5 

0.  <.03660 

06 

-0.169860 

02 

0. 390660 

05 

X ( 2 I 0.272060 

C6 

0.156660 

01 

0.266890 

02 

0.633990 

06 

XI3)  0.263020 

C 3 

0. 11 0560 

06 

0.151090 

01 

0.665990 

06 

X 1 6 ) -0.257280 

Cl 

0.^82660 

03 

-0.302300 

02 

0.555830 

03 

X I 5 1 0.  350000 

C 5 

0.255550 

03 

-0. 236950 

00 

0.205310 

05 

X(t»>  o.o 

0.  0 

0.671280 

00 

0.300510 

03 

XII)  0.605630 

C5 

0.606600 

06 

-0.200050 

02 

0.697200 

05 

X 1 2 1 0.272860 

C6 

0.156730 

01 

0.268580 

02 

0.666580 

06 

X 1 3 ) 0.290350 

C3 

0. 308730 

06 

0.195330 

01 

0.835  7 10 

06 

X | 6 ) -0.302100 

01 

0.6  7 7 730 

03 

-0.292370 

02 

0.626260 

C 3 

X 1 5 ) 0.  350000 

C5 

0.  255550 

03 

0.32  9 760 

00 

0.2*7160 

0 5 

X 1 6 ) 0.0 

0.0 

0.662100 

00 

0.616370 

03 

64 

T IME 

MEAN  OF  TRACK 

VAP.  or  TRACK 

MEAN  CF  ERROR 

VAR  OF  ERROR 

20 

XI  I ) 

0.4324 10 

C5 

0.404970 

0* 

-0.266241) 

02 

0.109450 

06 

X ( 2 1 

0.2/2060 

C4 

0.156940 

01 

0.237210 

02 

0.454210 

04 

xm 

o.  3i  mo 

C 3 

0. 30  7490 

06 

0.2912  70 

01 

0. 133830 

05 

XI4) 

-0. 339630 

01 

0.51 79*0 

03 

-0.280450 

02 

0.647930 

03 

X|5I 

0. 345260 

C 5 

0.691450 

05 

-0. 199631) 

01 

0.324430 

05 

X 1 6 1 

-0.947160 

C3 

0.2  75*80 

06 

-0. 511410 

01 

0.201690 

0 4 

21 

XI  1) 

0.459390 

05 

0. 404590 

06 

-0. 33648D 

02 

0. 157620 

06 

X | 2 ) 

0.272060 

C4 

0. 1571 70 

01 

0.236320 

02 

0.440170 

04 

X 4 3 1 

0.343540 

C 3 

0-307290 

06 

0. 387210 

01 

0.194300 

05 

X 1 4 1 

-0.3/4020 

Cl 

0.5  594  70 

03 

-0. 290930 

02 

0.643610 

03 

X ( 3 1 

0.334340 

05 

0.275000 

06 

-0.994400 

01 

0.429920 

05 

X | 6 1 

-0. 12380C 

04 

0.253040 

01 

-0. 108810 

02 

0.23  7540 

04 

22 

XIII 

0.406300 

05 

0.40457D 

06 

-0.383450 

02 

0.214370 

06 

X 1 2 1 

0.2  72060 

C 4 

0. 157620 

01 

0.253310 

02 

0.452760 

04 

Xlil 

0. 369650 

03 

0. 308020 

06 

0.477450 

01 

0.267950 

05 

X 1 4 1 

-0.419010 

Cl 

0.574420 

03 

-0.292670 

02 

0.690800 

03 

X 1 5 ) 

0.321560 

C5 

0.276000 

06 

-0.209020 

02 

0.579580 

05 

XI  61 

-0.  1 2 30 CO 

C4 

0.253040 

01 

-0.  109  340 

02 

0.237390 

04 

23 

XU) 

0.5133  /O 

C5 

0.404620 

06 

-0.425980 

02 

0.200560 

06 

X 1 2 I 

0.27286C 

C4 

0.158020 

01 

0.251020 

02 

0.454800 

04 

X 1 3 I 

0.  394  750 

C3 

0. 308780 

06 

0.406130 

01 

0. 351820 

05 

X ( 4 1 

-0.4/7210 

01 

0. 592420 

03 

-0.298090 

02 

0.696040 

03 

X 1 5 1 

0.309580 

C5 

0.276130 

06 

-0.318560 

02 

0. 775650 

05 

X | 6 1 

-0. 1238CP 

C4 

0.25  3040 

01 

-0. 109780 

02 

0.244690 

04 

24 

XII) 

0.540360 

05 

0.404950 

06 

-0.4  75990 

02 

0.355560 

06 

X 1 2 1 

0.2  7286C 

C4 

0.  157850 

01 

0.246090 

02 

0.456300 

04 

XI  3) 

0.420160 

C 3 

0. 310300 

06 

0.57502D 

01 

0.44  72<*C 

05 

X 1 4 ) 

-0.538180 

01 

0. 589500 

03 

-0. 292960 

02 

0. 723  700 

03 

XI  51 

0. 2972C0 

C 5 

0.2/O260 

06 

-0.429520 

02 

0.  102160 

06 

X 1 6 I 

-0.  123000 

C4 

0.253040 

01 

-0. 112090 

02 

0.245  770 

04 

25 

XII) 

0.567340 

05 

0.404960 

06 

-0.530400 

02 

0.439830 

06 

X ( 2 ) 

0.2  72060 

C4 

0. 159010 

01 

0.2444  70 

02 

0.459270 

04 

Xlil 

0.444600 

C 3 

0.313600 

06 

0.61 7890 

01 

0.559260 

05 

X 1 4 1 

-0.5S85CD 

Cl 

0.618970 

03 

-0.301540 

02 

0. 752610 

03 

X 4 3 I 

0. 204820 

C 5 

0.2  76390 

06 

-0.542040 

02 

0.131 760 

06 

XI  61 

-0.123800 

C4 

0.253040 

01 

-0. 112960 

02 

0.240020 

0 4 

26 

XI  1) 

0. 594330 

05 

0.405040 

06 

-0.5891 70 

02 

0.534060 

06 

X 1 2 1 

0.,2  7 2660 

C4 

0. 158060 

01 

0.241260 

02 

0.466140 

04 

Xlil 

0. 468620 

03 

0. 31 7340 

06 

0 . 5° 1 490 

01 

0.689630 

05 

X 1 4 ) 

-0. 652*40 

Cl 

0.63  7 7 60 

03 

-0. 306630 

02 

0.831560 

03 

X 1 5 1 

0.2/2440 

C5 

0.276530 

06 

-O.o 56400 

02 

0. 166250 

06 

X 1 6) 

-0. 123800 

C4 

0.253040 

01 

-0.115750 

02 

0.250440 

0 4 

27 

XII) 

0.621310 

05 

0.405490 

06 

-0.6*7900 

02 

0.638300 

06 

X 1 2 I 

0.27286C 

04 

0.  158450 

01 

0.240990 

02 

0.468000 

04 

Xlil 

0.491530 

C 3 

0. 322260 

06 

0.491400 

01 

0..  83  7590 

05 

X 4 4 | 

-0. 714090 

01 

0.666380 

03 

-0. 309320 

02 

0.856930 

03 

X 1 5 1 

0. 260060 

C 5 

0.2  766  70 

06 

-0. 7/4290 

02 

0.205 970 

06 

X 1 6 1 

-0. 12?  800 

C4 

0.253040 

01 

-0. 120050 

02 

0.259420 

04 

28 

Xlil 

0.648250 

05 

0.405530 

06 

-0. 715500 

02 

0. 751410 

06 

XI  2 1 

0.272860 

C4 

0. 150120 

01 

0.235430 

02 

0.468300 

04 

Xlil 

0.  5146  70 

C 3 

0. 329120 

06 

0.456600 

01 

0. 100520 

06 

X 1 4 | 

-0.  I423C0 

Cl 

0. *66100 

03 

-0.305070 

02 

0.940830 

03 

XI  5 I 

0.  24  76  70 

05 

0.2  76820 

06 

-0.893940 

02 

0.251090 

06 

X 1 4 | 

-0. 129800 

C4 

0.253040 

01 

-0. 1 19240 

02 

0.262050 

04 

29 

XII) 

0.675260 

C5 

0.405600 

06 

-0. 7/e970 

02 

0.874750 

06 

X 1 2 ) 

0.272660 

C4 

0. 158400 

01 

0.239490 

02 

0.474870 

04 

Xlil 

0.537210 

03 

0.334500 

06 

0.416020 

01 

0.118200 

06 

X I 4 | 

-0.  806 C 30 

Cl 

0.697710 

03 

-0.308500 

02 

0.877460 

03 

x 1 5 1 

0.235250 

c; 

0.276980 

06 

-0.101300 

03 

9.30157C 

06 

X 1 6 1 

-0. 1238C0 

C4 

0.253040 

01 

-0. 120500 

C2 

0.265420 

04 

; 

i 


i 


65 


TIME  MEAN  OF  TRACK  VAR  OF  TRACK  MEAN  OF  ERROR  VAR  OF  ERROR 


40 

xm 

0*9721 10 

05 

0.41 12 70 

06 

-0.150280 

03 

0.201430 

0 7 

X C 2 I 

0*272860 

C'» 

0.161200 

01 

0.228580 

02 

0.450  710 

04 

X ( 3 1 

0*  734950 

C 3 

0.505090 

06 

-0. 101160 

02 

0.456610 

06 

X € 4 1 

-0. 15956D 

C2 

0.323130 

03 

-0.3 32 780 

02 

0.  136  700 

04 

X ( 5 ) 

0.991050 

C4 

0.279010 

06 

-0.241150 

03 

0.123570 

07 

X ( 6 ) 

-O. 12380D 

04 

0.253040 

01 

-0.  I37f>00 

02 

0.306650 

04 

41 

xi  n 

0. 999C90 

C5 

0.411310 

06 

-0.157790 

03 

0.304440 

07 

X ( 2 1 

0*272860 

04 

0.161030 

01 

0.227000 

02 

0.460100 

04 

X < 3 1 

0.749120 

C3 

0.528130 

06 

-0.213440 

02 

0.5024  70 

06 

X 1 4 I 

-0. 161820 

C2 

0.81 7560 

03 

-0. 336730 

02 

0.137630 

04 

X ( 5 ) 

0.867280 

04 

0.279230 

06 

-0.254900 

03 

0.135650 

07 

X ( 6 ) 

-0. 123800 

C4 

0.253040 

01 

-0. 13  7420 

02 

0.310740 

04 

42 

xm 

0.  10  26  ID 

06 

0 • 4094  00 

06 

-0.164810 

03 

0.328240 

07 

X ( 2 ) 

0.273140 

C4 

0.15739U 

04 

0.227310 

02 

0.466010 

04 

X ( 3 ) 

0.  762  7C0 

C3 

0.551 710 

06 

-0.247270 

02 

0.549860 

06 

X < 4 1 

-0.171170 

02 

0.813800 

03 

-0.335450 

02 

0. 13  7260 

04 

X 1 5 1 

0.  743  750 

C4 

0.  2 79390 

06 

-0.269130 

03 

0.  148190 

0 7 

X ( 6 1 

-0. 123150 

C 4 

0. 761480 

04 

-0. 147290 

02 

0. 306460 

04 

43 

XU) 

0.105320 

06 

0.411660 

06 

-0.173440 

03 

0.354210 

07 

X < 2 ) 

0.  2 74550 

C4 

0.9195  70 

04 

0.202900 

02 

0.539910 

04 

X C 3 » 

0. 775400 

C 3 

0.578990 

06 

-0.283500 

02 

0.602070 

06 

XC4) 

-0. 171670 

C2 

0.82 3630 

03 

-0.233060 

02 

0.  149C00 

04 

X ( 5 ) 

0.622150 

C4 

0.290730 

06 

-0.205220 

03 

0. 160450 

07 

X ( 6 ) 

-0.  12009C 

04 

0. '#45860 

05 

-0.  1 74480 

02 

0.270940 

04 

44 

XU) 

0. 108  C 70 

C6 

0.445120 

06 

-0. 184620 

03 

0.381030 

0 7 

X<2) 

0.2ei5  W 

C4 

0.  '#13480 

05 

0. 169320 

02 

0.55  7040 

04 

X € 3 I 

0. 787200 

03 

0.606490 

06 

-0. 328  790 

02 

0.657450 

06 

X ( 4 ) 

-0. 1 74350 

C2 

0.8U330 

03 

-0.338750 

02 

0. 148  790 

04 

X ( 5 ) 

C. 505800 

C4 

0. 360060 

06 

-0.304190 

03 

0. 172060 

0 7 

X<6> 

-0.  104610 

C 4 

0.2 008 On 

06 

-0 . 2048  70 

02 

0. 245760 

04 

45 

XU) 

0.  1105<*0 

C6 

0.  55 090 

06 

-0.199730 

03 

j 

0.410070 

07 

X<2) 

0.297860 

04 

0. 7 79560 

05 

0. 130620 

02 

0.574030 

04 

X ( 3 ) 

0. 7986CD 

03 

0.634030 

05 

-0.377690 

02 

0.714250 

06 

X ( 4 ) 

-0.  102240 

C2 

0.  783220 

03 

-0.343590 

02 

0.  150120 

04 

x ( 5 ) 

0.42  3 140 

04 

0.6  77.890 

06 

-0.225440 

G3 

0.  183320 

07 

X ( 6 ) 

-0. 687030 

C 3 

0. 3 736  00 

06 

-0.2201 70 

02 

0.242490 

04 

46 

X(l  ) 

0.  113560 

C6 

0. 765420 

06 

-0.214360 

03 

0.441880 

0 7 

X 1 2 ) 

0. 313030 

C 4 

0.643200 

05 

0. 1 7 4 0 

02 

0.614780 

O'# 

X ( 3 ) 

0. 808550 

C3 

0.660090 

06 

-0.425480 

02 

0 . 772320 

06 

X ( 4 | 

-0. 1985C0 

02 

0. 7422 90 

03 

-0.341050 

02 

0.  144360 

04 

X ( 5 ) 

0.  371  160 

04 

0. L26350 

07 

-0.3446  70 

03 

0.  194340 

07 

X(  6 ) 

-0.  352  /IP 

C 3 

3. 312440 

06 

-0. 164400 

02 

0. 250650 

04 

47 

XU) 

0.117120 

06 

0.967280 

06 

-0.222760 

03 

0.474110 

07 

X ( 2 ) 

0. 324550 

C 4 

0.232380 

05 

0.247390 

02 

0.6584  10 

04 

X<3) 

0.819040 

03 

0.688680 

06 

-0.464020 

02 

0.832440 

06 

X ( 4 ) 

-0.204C5D 

02 

0.6950LO 

03 

-0. 339860 

02 

0.  14  72  70 

04 

X ( 5 ) 

0. 348580 

C4 

0.  1 7 7 740 

07 

-0.357350 

03 

0.204400 

07 

X<6) 

-0.938610 

02 

0. 1 12  750 

06 

-0.8901  70 

01 

0.226910 

04 

48 

X(  l) 

0.  120350 

C6 

0.  105720 

07 

-0.227460 

03 

0.508620 

07 

X ( 2 ) 

0.328200 

C4 

0.466510 

04 

0. 272200 

02 

0. 706850 

04 

X « 3 1 

0.027850 

03 

0.  711650 

06 

-0.5058  70 

02 

0.894460 

06 

XlM 

-0.210470 

C2 

0.66  7 740 

03 

-0. 342660 

02 

0.151910 

04 

X i 5 ) 

0.  342  720 

C4 

0.200320 

07 

-0.3641 50 

03 

0.21292D 

07 

X 1 6 ) 

-0.  133  760 

C2 

0.226320 

05 

-0.470460 

01 

0.  10  13  70 

04 

49 

X(  1 ) 

0.  123610 

06 

0.197420 

07 

-0.229350 

03 

0.545460 

07 

X 1 2 ) 

0.329050 

C 4 

0.273110 

01 

0.290070 

02 

0.  734690 

0* 

xjji 

0. 835350 

C 3 

0.  73  75  10 

06 

-0.541870 

02 

0.961190 

06 

X 4 4 1 

-0.226  140 

C 2 

0.695550 

02 

-0.334710 

02 

0.  L 5 0 3 90 

04 

X ( 5 ) 

0.341810 

04 

0.205450 

07 

- 0. 368000 

0 3 

0.220640 

07 

X 1 6 ) 

0.  1 786 CO 

CO 

0.225630 

01 

-0.315820 

01 

0. I6*s  10 

04 

TIME  MEAN  CF  TRACK  VAR  OF  TRACK  MEAN  CF  ERROR  VAR  OF  ERROR 


50 

XC 11 

0.  1263  70 

Cfc 

0.  1074  70 

07 

-0.230730 

03 

0.504260 

07 

X 1 2 1 

C- 329050 

C4 

0.2  7 4010 

01 

0 • 2 U 7 4 10 

02 

0.  736220 

04 

xm 

0.042950 

C 3 

0.  762310 

06 

-0.580630 

02 

0.  103000 

0 7 

X<4) 

-0.229240 

C2 

0.698580 

03 

-0. 337440 

02 

0.  160890 

04 

X ( 5 1 

0. 341 830 

C4 

0.205460 

07 

-0.371140 

03 

0. 228450 

07 

X<  6) 

0. 1986C0 

00 

0.225630 

01 

-0.295030 

01 

0.  160540 

04 

51 

X(  1 ) 

0.  130  l 2D 

06 

0.  107520 

07 

-0.232430 

03 

0.624340 

07 

xm 

0.  329050 

C4 

0.274160 

01 

0-2862  70 

02 

0. 731840 

04 

X ( 3 ) 

0.  049220 

C 3 

0. 788650 

06 

-0.626420 

02 

0. 1101 70 

07 

X(4| 

-0.23765C 

02 

0.703480 

03 

-0. 344370 

02 

0. 163060 

04 

X f 5 1 

0. 34185C 

C4 

0.205460 

07 

-0.374200 

03 

0.236740 

07 

X ( 6 ) 

0. 198600 

00 

0.225630 

01 

-0.333410 

01 

0. 1823  70 

04 

52 

xm 

0.133390 

06 

0.  107630 

07 

-0.233600 

03 

0.665430 

07 

X ( 2 1 

0. 329050 

C4 

0.280310 

01 

0.290090 

02 

0.  720860 

04 

X 1 3 1 

0.854570 

C 2 

0.81 1390 

06 

-0.672270 

02 

0.  1 1 73  70 

07 

X<4  7 

-0.2502  70 

02 

0.627810 

03 

-0.342250 

02 

0.  160601) 

04 

X<51 

0.341870 

C4 

0.2054  70 

07 

-0. 37  7260 

03 

0.245370 

07 

X<6) 

0.  1986C4) 

CO 

0.225630 

01 

-0.261 760 

01 

0. 1 R 1 390 

04 

53 

X t 1 1 

0.  136650 

06 

0.107530 

07 

-0.234710 

03 

0. 708300 

07 

X ( 2 1 

0. 329C50 

C 4 

0.280700 

01 

0.209040 

02 

0. 731 900 

04 

X < 3 t 

0.85951C 

C3 

0.831 770 

06 

-0. 706090 

02 

0.  124860 

07 

xm 

-0.257660 

C2 

0.618040 

03 

-0.332120 

02 

0. 163690 

04 

X 4 5 ) 

0.341890 

C4 

0. 205400 

07 

-0.379550 

C3 

0.254210 

07 

x i 6 1 

0.198600 

00 

0.225630 

01 

-0.  196220 

01 

0.  102C9O 

04 

54 

X(  l) 

0.  139510 

C 6 

0.10/600 

07 

-0.234800 

03 

0. 752710 

07 

X 4 2 ) 

0.329050 

C 4 

0.200220 

01 

0.294970 

02 

0.737560 

04 

X 4 3 ) 

0.063750 

C 3 

0.352040 

06 

-0.735310 

02 
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0.402370 

06 

0.927540 

00 

0. 291620 

04 

XU) 

-0. 988650 

02 

0.102000 

05 

-0.28/770 

02 

0.2912  70 

04 

X ( 5 1 

0.311150 

04 

0.33/850 

07 

-0.263000 

03 

0.644240 

07 

X(6> 

-0.951220 

Cl 

0.  1 742  70 

05 

0.223690 

01 

0.352610 

04 

XUI 

0.232040 

C6 

0.485970 

07 

0.146710 

02 

0.300510 

05 

X ( £ ) 

0.338560 

C4 

0.560730 

05 

0- 376290 

02 

0.  759020 

04 

XUI 

0. 3 74  ICO 

03 

0. 322690 

06 

0.478950 

01 

0.109900 

05 

XU) 

-0.113660 

03 

0.135140 

05 

-0.280520 

02 

0.269340 

04 

X(5I 

0.326820 

C4 

0.28/080 

07 

-0.401900 

02 

0.  596670 

07 

X 1 6 ) 

-0. 168430 

C2 

0.251380 

05 

0. 772270 

01 

0.280600 

04 

xui 

0.234810 

C6 

0.176510 

07 

0.124140 

02 

0.630940 

05 

XI  2\ 

0. 334250 

C4 

0-340230 

05 

0.352010 

02 

0.707930 

04 

XI3) 

0.302750 

C3 

0.216000 

06 

0. 763250 

01 

0. 251960 

05 

xm 

-0.123  740 

C3 

0.201270 

05 

-0.279570 

02 

0. 200620 

04 

X15I 

0. 346900 

C 4 

0.253020 

07 

0.279300 

03 

0.537130 

07 

X(6) 

-0.907740 

Cl 

0.  1 3 75  70 

05 

0. 132440 

02 

0.272000 

04 

xm 

0.23735C 

C6 

0.944410 

06 

0.21Q920 

02 

0.  100310 

Ofc 

XU) 

0. 331240 

C4 

0. 1 76540 

05 

0.360050 

02 

0.6445  70 

04 

X ( 3 ) 

0.20925C 

03 

0.105700 

06 

o.  102  no 

02 

0. 436540 

05 

XIX) 

-0. 148CO0 

C3 

0.331500 

05 

-0.202040 

02 

0.266710 

04 

XUI 

0. 353120 

C4 

0.2104  70 

07 

0.405330 

03 

0.495660 

07 

XI6I 

-0.198010 

02 

0.2942 70 

05 

0.  1 6 368 1) 

02 

0.259420 

04 

X(l) 

0.239610 

C6 

0.166260 

06 

0.307370 

03 

0.609020 

05 

XU) 

0. 328050 

C4 

0.9554  70 

03 

0.922180 

02 

0.239820 

04 

XUI 

0. 741/50 

C2 

0.510400 

05 

-0.975580 

02 

0.494680 

05 

xm 

-0.  1602  70 

C 3 

0.673910 

05 

-0.522390 

02 

0. 10  7150 

04 

XU) 

0.23782C 

C4 

0.  112580 

07 

-0. 1 16540 

C4 

0.282860 

07 

X ( A) 

0.479920 

00 

0.240020 

01 

0. 11322D 

0?  • 

0.139810 

04 

APPENDIX  C 


RESULTS  OF  ATIGS  SIMULATION  WITH  POSITION  RESET  AND  KALMAN 

FILTERING 
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Ill  IIHEISEO 


Pigure  21  - SQRT  OF  DOWN  RANGE  VARIANCE  <ATIGS  WITH 
POSITION  RESET  AND  KALMAN  FILTERING) 


in  mho 


Figure  22  - SQRT  OF  CROSS  RANGE  VARIANCE  <AriGS  WITH 
POSITION  RESET  AND  KALKAN  FILTERING) 


APPENDIX  D 


RESULTS  OF  ATIGS  SIMULATION  WITH  POSITION  RESET  AND  KALMAN 
FILTERING  AT  X5  NOISE  LEVEL 
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110  THE  (5E0 


Figure  26  - SQRT«  OF  CROSS-RANGE  VARIANCE  <ATIG5  WITH  POSIT 
RESET  AND  KALMAN  FILTERING  AT  THE  X5  NOISE  LEVEL* 


Figure  28  - SQR  T*  OF  CROSS-RANGE  VELOCITY  VARIANCE  < ATIGS 
WITH  POSIT  RESET  AND  KALMAN  FILTERING  AT  THE  X5  NOISE  LEVEL  * 
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APPENDIX  E 

PARTIAL  LISTING  OF  SYMBOLS  AND  NOMENCLATURE  OF  SIMULATION 

PROGRAM 


THETA  (i,  j) 

XI(i,  j) 

THETA  (i,  j) 

XBAR  (i,  j) 

XBVAR  (i,  j) 

XMEAN  (i,  j) 

XVAR  (i,  j) 

A(j) 

AWXY 
A WYY 
AWYZ 
AWZZ 

AWXX 
DEL  VX 
DEL  VY 


i-th  missile  state  at  time  j 
i-th  angular  state  variable  at  time  j 
estimated  i-th  state  at  time  j 
estimated  i-th  angular  state  at  time  j 
mean  of  i-th  state  at  time  j 
variance  of  i-th  state  at  time  j 
error  mean  of  i-th  estimated  state 
error  variance  of  i-th  estimated  state 
thrust  acceleration  at  time  j 


velocity  changes  due  to  angular  rotation 
changes  in  wind  components 
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J 


BET  A1 
BETA2 
BET  A3 

YIX 

YIY 

YIZ 

XPOS 

YPOS 

G 1 
G2 

OMEGAX 

OMEGAY 

XINT 

PSI 

XFIN  (i) 

NTERM 

VXO 

VYO 

IX 

DTHTAX 

dthtxm 


body  referenced  accelerations 

inertial  referenced  accelerations 

v 

micrad  sensed  positions 

Kalman  gains  for  filter 

extra  states  for  Kalman  filter 

dummy  variable  for  output 

change  in  drift  angle 

final  value  of  i-th  state  per  track 

maximum  time  steps  allowed 

velocity  of  wind  down-range 

velocity  of  wind  cross-range 

seed  number  for  random  number  generators 

change  in  thetax 

measured  change  in  thetax 


ZNI  (j) 


total  tracks  through  time  j 


XIFIN  (i) 

track 

XBFIN  (i) 
XIBFN  (i) 
XBF  V (i) 

N 

NBA 

IENSB 

SIGEO 

SIGH 

SIGK 

SIGEG 

SIGKG 

factor 

SIGT 

theta 


final  value  of  estimated  i-th  state  per 

mean  of  XFIN(i) 

mean  of  XIFIN  (i) 

variance  of  XFIN(i) 

number  of  gyros  simulated 

number  of  accelerometers  simulated 

size  of  ensemble 

std. deviation  of  gyro  bias 

std. deviation  of  gyro  random  walk 

std. deviation  of  gyro  scale  factor 

std. deviation  of  accelerometer  bias 

std. deviation  of  accelerometer  scale 

std. deviation  of  initial  condition  on 
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//  EXEC  FORTCLGP,RE3ION=180K 
//FORT. SYSIN  DD  * 


X <1,J) 
x (2,J) 

X 13, J) 

xi4(0) 


XBAR 

XMEAN 


THE  ACTUAL  POSITION  ALONG  THE  DOWNRANGE 
AXIS 

THE  AIRSPEED  IN  THE  DOWNRANGE  DIRECTION 
NOTE  IT  IS  NOT  THE  ACTUAL  VELOCITY 
CROSSFANGE  POSITION 
CROSS  RANGE  AIRSPEED 

THE  INERTI ALLY  COMPUTED  STATES  ALONG  THE 
DOWN-RANGE/CROSS-RANGE  AXIS 
THE  MATRIX  OF  MEAN  VALUES  OF  THE  MONTE- 
CARLO  GENERATED  TRACKS  OF  THE  X MATRIX 
THE  MATRIX  OF  MONTECARLO  GENERATED 
MEANS  OF  THE  XI  MATRIX 


DIMENSION  NA  ( 3)  ,EOG(3)  ,WG(3)  ,?SI  (150)  ,GAM(3)  ,ZNI(150)  , 
DIMENSION  THETA  (3,150)  .THETAI (3, 150)  ,G (3) , EO (3)  ,ZK  (3)  , 
DIMENSION  A ( 150)  ,XFIN(6)  ,XIFIN(6)  ,YF(150)  ,XINT(150)  ,XP 
REAL*8  XB FIN (6)  , XIBFN (6)  , XBFV  (6)  ,XIBFV{6)  ,XM1,XM3 
REALMS  X3  AH  (6, 155)  ,X3VAR  (6,155)  ,X  (6, 15d)  , XI  (6, 1 55) 
REAL*8  XMEAN (6, 150) ,XVAR (6, 150) 

DIMENSION  ERR  (6) 

THIS  SECTION  READS  IN  THE  VARIOUS  NECESSARY  SPECIFICAT 
"N  '*  THE  NUM3ER  OF  GYROS  INVOLVED  PER  SIMULATION 
"NNA"  THE  NUM3ER  OF  ACCELEROMETERS  PEE  SIMULATION 
"IENSB"  THE  NUMBER  OF  THE  ENSEM3LE 

RE  AD  (5,  30  0)  N,  NNA,  IENSB 

"SIGEO"  IS  THE  DIVIATION  OF  THE  GYRO  BIAS 
"SIGN " IS  THE  DEVIATION  OF  THE  RANDOM  WALK  CONSTANT 
FOR  THE  GYROS 

"SIGK"  IS  THE  DEVIATION  OF  THE  SCALE  FACTOR  (GYRO) 

"SIGSG"  IS  THE  DEVIATION  OF  THE  ACCEL.  BIAS 

"SIGK  G"  IS  THE  DEVIATION  OF  THE  ACCEL  SCALE  FACTOR 

"SIGT"  IS  THE  DEVIATION  OF  THE  INITIAL  CONDITION 

ON  THETA 


IMENSION  A (150)  , £ FIN  (6)  , XI Fill  (6)  ,Y^(l50)  ,XIllT 
EAL*3  XB  FIN (6)  , XIBFN (6  , XBFV  (6)  , XIBFV{6)  ,XM1, 
EAL*8  X3AR  (6,155)  ,X3VAR  (6,155)  ,X  (6, 15d)  , XI  (6, 
EAL*8  XMEAN (6, 150) ,XVAR (6, 150) 


, WG(3)  , PS  1(150)  , G AM  (3 ) ,ZN  1(150)  , 
.THETAI  (3, 150)  ,G  (3)  , EO  (3)  ,ZK  (3  , 
6)  , XIFIN  (b ) , YF  (150)  ,XINT(150)  ,XP 
6i  , XBFV jb)  .XIBFVJ6)  ,XM1,XM3 


"SIGT" 


READ (5,310) SIGEO, SIGW, SIGK, SIG EG, SIGKG, SIGT 

"SIGMIC"  IS  THE  DEVIATION  OF  THE  POSIT  ION  MEASUREMEN 


READ  (5,31  0)  SIGMIC 
WRITE  (o,420) N, NNA, TENS 3 
WRITE  (6,44  0 SIG EO , SIG W , SIGK , SIG EG  , SIG KG , SIGT 
WRITE (6 ,500) SIGMIC 
CALL  OV  FLOW 
INDX1 =1 
INDX2= 1 
I NDX3= 1 
N DEBG= 1 
YP=0. 0 
NTERM  = 100 
IA=1 
IE=3 

I X=  11 1 1 1 
VXO=30. 0 
V YO=3  0. 0 
DO  02  J=1, NTERM 
DO  01  K=1 ,6 
XMEAN  (K,J) =0.0 
X VAR  (K,  J)  =0.0 
XEAR  (K, J) =0.0 
XEVAR (K.J) =0.0 

01  CONTINUE 

02  CONTINUE 

GENERATE  THE  THRUST  ACCELERATION  PROFILE 


A (1)  =2. 0 
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1 


03 


04 


05 


10 


A 

D 0 Ut  U “ I | u 
XBFIN (J) =0.0 


=6.0 
= 10.0 
= 14.0 
= 14.0 
= 10.0 
=6.0 
=2.0 
=-1.0 

3 1=10,150 
I)  =0.0 
04  J=1 .6 

, )=0.o 

XIBFN  iJ) =0 . 0 
XBFV  (J)  =0.0  ' 

XIBFV (J) =0.0 
DO  05  1=1. NTERM 
ZNI  (I)  =0.0 
A (I)  =A  ( I)  *32.2 

START  THE  MONTECARLO  S IHULATION 

DO  200  NI=  1, IENSB 
TIMEX=1 .0 
OMEGAY=  0 . 0 

0 MEGAX=  0.0 

THE  PURPOSE  OF  THIS  SECTION  IS  TO  COMPUTE  THE  INITIAL 
CONDITION  FOR  THE  ACTUAL  TRACK  OF  THE  MISSILE. 

CALL  RANDU  (IX,IY,XFL) 

IX=IY 

X (1,1)  =XFL*2240. 0-1 120.0 
CALL  RANDU (IX, IY, YFL) 

1 X=IY 

IFj(  (XFL**2+YFL**2)  .GT  .1 .0)  GO  TO  10 


2,1 

3. 1 

4.1 

5.1 


=700.0 
=YFL*2240. 0-1120.0 
= 0.0 
=35000. 


X (6, 1)  =0.0 

GENERATE  THE  INITIAL  CONDITIONS  ON  THETA 

CALL  SHORM  (IX  ,T  , N) 

DO  11  J=1 , N 
THETAI  ( J , 1) =0.0 
11  THETA  (J,1)  =T  (J)  *SIGT 

THE  INITIAL  SETTING  OF  THE  INERTIAL  NAVIGATOR  IS 
ZERO  POSITION  IN  DOWN-RANGE  AND  CROSS-RANGE  AND  TH; 
ACTUAL  VELOCITY  AND  ALTITUDE 


XI 

XI 

XI 

XI 

XI 

XI 


1,  1 
2,1 


4.1 

5.1 

AX  1 6 , 1 / — U . 

DT  HTAX=  0.0 
DTHTA Y=0. 0 
DTHTAZ=0. 0 


=0.0 

=670.0 


3,1  =0.0 

it  a \ n 


=3  0.0 
=35000.0 
=0.0 


THE  PURPOSE  OF  THIS  SECTION  IS  TO  PRODUCE  THE  ACTUAL 
TRACK  OF  THE  SIMULATED  MISSILE  FOR  COMPARISON  WITH 
OTHER  ESTIMATES  OF  POSITION 
WIND  EFFECTS  ARE  COMPUTED  FIRST 

THE  INITIAL  VALUE  OF  C IS  ALWAYS  ZERO 
C = 0.0 

THE  VARIOUS  RANDOM  INPUTS  FOR  MEASUREMENT  DEVICES  AF:E 
GENERATED 
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GENERATE  GYRO  BIAS  "EO" 
CALI  SNORM  (IX  ,E0  , N) 

DO  18  KN=1,N 
18  EC  (KN)  =SIGEO*SO  (KN) 


GENERATE  THE  RANDOM  SCALE  FACTOR  "ZK" 

CALL  SNORM  (IX, ZK,  N) 

DO  19  K N=  1 , N 

19  ZK(KN)  =SIGK*ZK(KN) 

GENERATE  RANDOM  INPUTS  TO  ACCELEROMETER  PACKAGE 

GENERATE  ACCELEROMETER  BIAS  " EO G " 

CALL  SNORM  (IX  ,EOG , NNA) 

DO  20  KN= 1 , NNA 

20  ECG  (KN)  =SIGEG*EOG  (KN) 


30 


GENERATE  ACCELEROMETER  SCALE  FACTOR  "KG" 
CALL  SNORM (IX, WG, NNA) 

DO  30  KN= 1 , NNA 
WG  (KN) = SIGKG*WG  (KN) 

DO  100  J=1 , NTERM 
ZNI  (J)  =ZNI  (J)  +1.0 
JP1=J+1 

CALL  RANDU  (IX, IY,  VY) 

I X=I  Y 

CALL  RANDU  (IX, IY.VX) 

VY=30+ ( VY*  to . 67-8 . 33) 

VX=30+  (VX*16.67-3. 33) 

I X=I  Y 

A WXX=X (6, J) *DTHTAX 
AWXY=-X  (4  , J)  *DTHT  AY 
A WYY=X  (2, J) *DTHTA  Y 
A W YZ=X  (6, J *DTHTAZ 
AWZZ  =-X  (4  , J)  - 


AWZZ=-X  (4  , J)  *DTHT AZ 
A WZX=— X (2,  j[*DTHTAX 
A Y=A  (J)  *THETA  (2  , J) 


THETA 

THETA 

THETA 


'1,JPl)'=^HET.i 
2 ,JP1)  =THET  A 


X 

1,JP1 

= X 

1,  J) 

X 

2 , JP1 

= X i 

2 , J 

X 

3,JP1 

|=X 

3'J 

X 

4 , JP  1 

=x 

4,  J' 

X 

5 , JP1 

1 =x 

5,J 

X 

6 , JP  1 

= x 

6,J 

+ X (2 
+ A (J 
+ X (4 
+ AY  + 


1 , J) +DTHTAX 

2,  J)  +DTHTAY 

3 ,  J) +DTHTAZ 
. J) -VX+ .5*  ( 

A WXY 


5*  (A  (J)  +AWXX+  AWXY) 


+ X 
+ AI 


GAM  C 

1)  =EOG  (' 

1)  +WG  (1) 

GAM  {: 

l = EO G (; 

> +WG  (2) 

gam 

) = EOG  (; 

1) 

,J) +.5*  (AY+AMYZ+AWYY)  +VY 
AWYZ+AWYY 

[ (6,  J)  +.5*  (AWZX  + AWZZ) 
lWZX+AWZZ 

GAM  IS  THE  NOISE  INPUT  FOR  £ACH  ACCELEROMETER 

**cA  (J) 

GENERATE  THE  BIAS  TERM  DUE  TO  RANDOM  WALK 

CALL  SNORM  (IX ,G , N) 

DO  50  JI= 1 » N 

50  G (JI)  =SIGW*G  (JI) 

PSI  IS  THE  CHANGE  IN  THE  ANGLE  BETWEEN  THE  COM? 
COORDINATE  PLANE  AND  THE  ACTUAL  COORDINATE  PLAN 

DO  51  JI=1,N 

51  PSI  (JI)  =EO  (JI)  +G  (JI) 

DELvX= VXO-VX 

DEL  VY=  V YO- VY 

COMPUTE  INERTIAL  POSITION 


DTHTXM=  DTHTAX+PSI  (1) + DTHT  AX  +ZK ( 1 ) 
DTHTYM=  DTHTAY  +PS I (2) *DTHTAY*ZK (2) 
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nnnn  nnnonnnnno  non  nnn  nnnnn  noon  nnn  nonn  noon 


DTHTZM=DTHTAZ+PSI  (3) +DTHTAZ*ZK  (3) 

THE  GAINS  G 1 AND  G2  ARE  THE  KALMAN  GAINS  GENERATED  AS 
A FUNCTION  OF  TIME 

G 1=1. 0-2.0/ (TIM EX*  1.0) 

G2=1.0/ (TIMEX+1 .0) 

THE  COMMANDED  HEADING  CHANGE  IS  SUBTRACTED  FROM  THE 
OESERVED  HEADING  CHANGE 

DLYJ=DTHT YM-DTHTA Y 
DLXJ=DTHTXM-DTHT AX 

THE  FILTER  UPDATE  EQUATIONS  FOLLOW 

THETAI  (1,  J)  =THETAI  (1  , J)  +G1*  (DLX  J-GMEGAX) 
CMEGAX=OMEGAX+G2*  (DLXJ-OMEGAX) 

THETAI (2, J) =THETAI (2. J)  +G 1 * (DLYU-OMEGAY) 
OMEGAY=OMEGAY+G2*  (DLY  J-OMEG  AY) 

THE  FILTERED  UPDATES  ARE  USED  TO  PREDICT  THE  NEXT 
STATE  IN  THE  NAVIGATOR 

THETAI ( 1,JP1)  =THETAI  (1,J) +DTHTA X+OMEGAX 
THETAI (2 , JP1 ) =THETAI  (2 , J)  +DTHT AY+OMEGAY 
THETAI ( 3,  JP 1)  =THETAI  (3,  J)  +DTHTZM 
TIMEX=TIMEX+1 .0 

SENSED  ACCELEROMETER  INPUTS  IN  THE  BODY  AXIS  FRAME 

IN  THE  X (BODY  FRAME) DIRECTION 

EET  A1  = A (J)  -DELVX+D EL VY* THETA  (2,  J)  +GAM  (1) 

IN  THE  Y (30DY  FRAME)  DIRECTION 
BETA2=DELVX*THETA  (2 , J) +DELV Y+G AM  (2) 

IN  THE  VERTI CAL ( BODY  FR AM E) DIR ECTION 
BETA3=0 . 0 


THE  PURPOSE  O?  THIS  SECTION  IS  TO  GENERATE  THE 
INERTIAL  ESTIMATES  OF  POSITION  BASED  ON  A PURE 
INERTIAL  COMPUTATION 

AW XXI  IS  THE  ACCELERATIONS  DUE  TO  HEADING  CHANGE 

AFFECTING  THE  X DIRECTION  FROM  THE  ANGLE  CHANGE  THETA 

X.  SIMILARLY  AWXYI  IS  THE  ACCELERATIONS  AFFECTING 

THE  X DIRECTION  DUE  TO  THETAY 

AWXXI=XI (6, J) *DTHTAX 

A WXYI=-  XI  (4  , J)  *DTHTA  Y 

AKYYI=XI  (Z,J) *DTHTAY 

AWYZI=XI  (6.  J)  +DTHTZM 

A WZZI=-  XI  (4  , J)  *DTHTZM 

AWZXI=-Xlj2, J *DTHTAX 

DTHTXM=  0.0 

DTHTYM=0. 0 

DTHTZM=0. 0 

DTHTAX=0. 0 

DTHTA Y=  0 . 0 

DTHTAZ=0. 0 

SENSED  ACCELERATIONS  IN  THE  BODY  FRAME  ARE  CONVERTED 
TO  THE  INERTIAL  FRAME. 

YIX  = BETA1-BETA2*THETAI  12, J) 

YIY=BETA1*THETAI  (2  . J)  +BETA2 
IE  (J.  EQ  . 15)  GO  TO  4§ 

IF  (J.  NE.  80)  GO  TO  49 
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GENERATE  THE  RANDOM  ERROR  IN  THE  POSITION  MEASUREMENT 


48  CALL  SNORM  (IX  ,XPOS,  1) 

XEOS=XPOS*SIGMIC 
CALL  SNORM  (IX, IPOS,  1) 

YPOS=YPOS*SIGMIC 

XI  (1,J)  =XPOS+X (1, J) 

XI  (3, J =YPOS+X  (3  , J) 

49  CONTINUE 

XI  (6  , J)  =X  (6,  J) 

COMPUTE  THE  INERTIAL  ESTIMATES  OF  POSITION 
AND  VELOCITY 

XI  (1,  JP1)  = XI  (1 , J)  + XI  (2.  J)  + . 5*  (YIX+AWXXI+ AWXYI) 

XI(2,JP1  =XI(2,J  +YIX+AWXXI+AWXYI 

XI  (3,J?1)  = XI  3,  J)  +XI  (4.  J)  + . 5*  (YIY+AWYYI+AWYZI) 

XI  (4 , JP  1 =XI i 4 , J +YI Y+ AWY YI+ AWYZI 

XI  (5, JP  1 =XI  (5,J  +XI  (6,J) +.5*(AHZZI  + ANZXI) 

XI  (6,  JP1  =XI  6 , J) +AWZZI+AWZXT 

VXO=VX 

VYO=VY 

IF  (XI(1,JP1)  .GE.  40000.)  DTHTAX=.  4538-THETA  (1,JP1) 
IF  JXlh.JPI)  .LE. 5000.)  DTHTAX=-THETA  (1,  JP1) 
IF(EABS (XI  (3,JP1) ) .LE  .150.) GO  TO  88 
REM=240000.-XI (1, 

IF  (REM. LE. .001) GO  TO  88 

CCNTP.L=X  (3. J) /REM 

DTHTAY= -CONTRL-THETAI (2,JP1) 

88  CONTINUE 

THIS  SECTION  GENERATES  THE  REQUIRED  STATISTICS 

DC  39  K=1 , 6 

ERR  (K)  =X  (K,  J)  -XI  (K , J) 

XMEAN (K ,J)  =XMEA  N (K,  J)  +S3R (K) 

XEAR (K,  J) =X3AR  (K, J) +X  (K,J) 


IF  (XI  (1  , J+  1 ) .GT. 2 
GO  TO  100 
DO  91  1=1 ,6 
XFIN  (I)  =X  (I, J) 
XIFIN  (1) = XI  (1 , J) 
XIFIN  (3)  =XI  (3,  J) 
XIFIN (5) =XI  (5 , J) 
GO  TO  1 10 
CONTINUE 
DC  101  1=1 ,6 
XFIN  (I)  =X  (I, 150) 
XIFIN (1) =XI (1 , IdO 
XIFIN  (3 ) =XI  (3,150 
XIFIN (5) =XI (5,150 


GT.  240000. ) GO  TO 


XIFIN 


5,  150 


THIS  SECTION  COMPUTES  THE  FINAL  VALUE  STATISTICS 


DO  120 
XEFIN  (J 
XIBFN  ri 
XIBFN  i’ 3 
XIEFN i 5 
X ERR 1 = X 
XERR3=X 


IF  (XERR 
XBFV  f 1) 
IF  (XERP 
XBFV  (3) 
CONTINU 


J=  1 , 6 
=XBFIN (J 
'■  =X I3FN  ill 
= X I3FN  i1 3 
)_=XI3FN  < 5j 
FIN  (1)  -XI? 
FIN  (3  -XI F 
1.LE.  .001) 
= X BFV  (1)  ♦! 
3.LE.  .001) 
= X3?V  (3)  ^X 
E 


♦ XFIN  ( J) 

♦ XIFIN  (1) 

♦ XIFIN  (3 

♦ XIFIN  (5 
IN  ( 1) 

IN  3j 

GO  TO  121 
ERR  1 **2 
GO  TO  200 
ERR3**2 
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